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(5 7) Abstract: 

PROBLEM TO BE SOLVED: To smooth the vertical movement of an 
upper body and movement of joints by providing an upper body vertical 
target position deciding means which decides the vertical target position 
of the upper body based on the upper body locus and a leg part link 
locus. 

SOLUTION: A walking way of the feet is decided so as to be stored in a 
ROM 84 of a control unit 26 as a foot flat locus parameter. An upper 
body locus parameter is so decided as to satisfy a decided target ZMP 
and stored in the ROM 84. The stored parameters are read out one after 
another so as to be inputted in a foot flat locus calculation algorithm and 
an upper body locus calculation algorithm so that a leg part link locus 
containing at least either one of the target position or the posture in the 
tip part of the leg link, namely, the foot flat position and posture of the 
both legs and the upper body posture and a horizontal position are 
calculated. 
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[»*J9 l ] <J>& < £ £ . ms&Mm l ©M 

fis£/ruT^3ns«s^©«g|sy >^ i*»6&»> > 

a. OTlB±ft©7K^|Sia«{iiSfcJ:C) £ ^©^%< £ 

b. WgBJSPSB 'J > *5fc4»©@tt${4H*5J: tf*l$©4>fc 10 

c . fluietgs $ nfc±f*»BMB J: ora »; > * Mtttcs 
*«*5£*i«js-r *©»**KW§B±tt©*& 

[t#*JS2] fBB±ft©«&a*i^ttwcwr*a9*w 20 
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asstr * sci £ -r 5 if *^ i iiiatg©ws#K) 

[ 3 ] ffria* 1 *s ± cf» 2 ©h«s©4>& < <t t> . 

B<iSB»2©MiS©^fi[*jJ:0*3iJS©iJ>fe< i^^-r 

S 2 Jf iBt&WJSWtt v V <J>&S&sS8m. 
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£-r-sif*ffl 1 m^L4m(D^-rtiMcniM(Dm^M- 

[ If 3&H 6 ] HILhfttBfiKnSl . 
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h. «rE«3esnyt±f«u»£. »» »;>**»£, * 

i . fWBBtJWBfiifa <bfc£ <fc 5 tcffllB$ 1 **<fce«»2 © 

■T5f»*a 1 mti^ b 9^©l=>Tn^{clB$g©WIS^» 
P**? h©^S*iSilg 0 

[1*^91 1 ] ttlBlfe^SlbniK? b*J2J9*#rs 
miatf? hrftO, mtam 1 ©B8j»36«fl8M«. fJfBS! 
2©H«S3&*«H8!S-C*4C £?r#i![£-r5f»*iM 1^ 
I^LIO S©t,>-f ft#>iCfBig©W^»a#" f h ©#^ 

[ i 2 ] tmrnsMW n >k » h w 3 jwjy ±©w 
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^fe±#*r©IB*#II©£</ >^©«S©ffiJ:«3 F-©^£j^g*^TSC£&tf»l$ftSfl«J£ 
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a > h >±©KfTl»KJ:oT±fl«DB*flS3©H _bf*tc^ 1 ©MfflS*^-0'ri*IS3n&aB»2p:©Wai5y > 

o\ S6(cigji/^±, isa/fija^tf* £©iifi. fln ©*§*^iig{c*jt,>r. «rta±ft©7.tep#[*is*iiteg 

^aojt^&^^&^yx-^H *ij;o*^©^>jfe< i^^-rn*^^, 995B±<*©is 

[0007] ^n^r^cr^s * > 3 >±© a:^[Si@«{4a^i^< . ±.iffl,mzmm-rz>±fomm 
ffifmm-v^&tfcosmmz zwsz. Lt*<ct s^s. wrsawsis y > ^sass^a*^** <tcra»© 
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S3#IW©ct>© l ipfc. BWfSSsS 5T\ ZXfll*si,>BZYW±®«r*or*>J; 

i*3£-rsc£ i ysig3ftTt,>& < , c©^a-c« v -r^ [o o 1 4] &$oM2mcabixiz. mz±.fc<D$&m3; 
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¥ffi8tJWW©fi3*«A&l>ER?K ^-T±IB©^#*S8 40 C«&2©Wtt©4>& < £ *>V>m*>©*fflKWJ-*»6. 

[0009] u#>u c©fie*Rf(f^s«:«fc« t [0015] fftiaKc^^ttt, Miam 1 *s&zm 
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WfflWJSW*. iraaS2 0IBf8S3&SBH«ffi-r*4*n<«JiS 

[0 02 4] «*IB 1 ZSKiotB. Mfaws#«jp 
# » h as 3 ««±©«§|5£?r-f 5 gs-WMr n JK h T * 30 

jaaw«5-c*s*n<«tesoA:. 
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S £B§K ^ 7 ^ - * 6ft £ £ t . *Mf rf(C >; T Jl/ 
[0 026] E{Cttft5i3n*:±ftWS*#t>*»** 40 
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[#6"H§©IU§i©7f38] WT, jRWHas^O-CCOfS 
itSJ(c, HeSPflttcuff* h£U-r2JS (2JW) #ffp# 
[0 02 8] II B*CD2fiiMf OjK ? h 1 £$t?»g 

4<*©ssii?*o . m 2 «^e© 2 s^tp ? n © 

a©S«Kl,^*sut7nTX^Jl, F>|t$,^„ 50 
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[0 02 9] m^n<Diu< . 2H£fcfTiajK7 h 1 

ft*ft©w» 2 «ce «©»»*«*. a <»»©« 

■T) o 6ffl©H®tt±*»6«c. Jg (MSB) ©W§IM 
ffl©HB®l OR. 1 0L (fflfcR, £ffl"J*L£-rS 0 
feTHalD) . M (MSP) ©f^^lnj (Y«*to0. M 

^mmzicm-r) ©hash 2 r, 12L, laio-;^ 

|n) <X**:b«). PI«(C02(C^?-) ©W®14R, 1 
4 L . ^R©f » *2f|fi|©«fltt 1 6 R, 1 6 L (SMBL 
2 ©TO) . £gp© tT v ?-*[fiJ©Mfi5 1 8 R , 18 
U Ra-;^OM82 0R. 2 0 LrfpfcHteSSft 

So 

[0 03 0 ] S§|5(C«Jg¥2 2 R, 22 L*SB(#Stl 
5„ ft, C©BJffl#r*B, JE (foot)?: rj£5fij iC^ 

©rtSPCC0 3 (CM L-Tf^-T ^ v ^03>t* i -^ 
6ft5«»aiy h2 6tt£*s|MfiStiS. ±fH(cfe^ 
-Cfl^MtS (RHffi) (mflBL/cHl©M«5) (*M® 1 0 
R(L), 12R(L>, 1 4R (L) JSmBBffi 
«Cl» LJSMffittlWfflll 8R (L) , 2 0R(L) *6i 

Sfc«§TO£MMS5£»^:M'J>^2 8R, 
28L, Baifl»tfiM»£»TIgy>*3 0R. 30L 

[0 0 3 1 ] ±ia©fltJi£(C <fc 9 , W§|5 'J > ^ 2 »^&© 

fi(c-3i*r*n-eti6-o©es^#^.^n, 
cti6©6 x2 = i 2ffl©wgB*iis:%ftffi-cigKi-r5 
c£r, s^»{cBfao»sr*-^ASc£3&J-c*. ffis 

1 ©Mg5iiS6*!lffll(Cfcl»-r , ffi«m«a2 (c^-T =fc 5 
(C, 5:^«I^«ji£T^„ >J>5'9 2, 9 4, 9 

C 0 0 3 2 3 jSJ. C©W#-ClftiS3tt, ±f*2 4© 
ff5efiiB*KW:0. *ft»K:«±#2 4rt©£6W 
(I2tC^9 8t^t) &£©fm*j£«r£„ 
[0 03 3] HI (C^TfcK . SMfi5©T*(CK^n© 
6*|*-b>1f-4 4*«K*3tl. ^7©3^[Sj^Fx. F 
y, Fzit-y>F©3t^Mx, My, Mzi 
L , J£g|5©#iife©W^fe I » U (*Sitfe#fiJfe 

[ 0 0 3 4 ] 0 3 J-r. y h 2 6 ©Sftffl^-r^n 

6o ^-C(Cfc%sTfflM-fe>f-6 0^c£©Hi^JBA/D^ 
J^S7 Of^^^tttC^ffeSti. «©ffl*(*^X7 2 
*^-LrRAM7 4{C3ae.tiS. *^*Wtt*-*(cB 
@L-riBg2*a^x>3-^©m^j(i^7>?>^7 e*/i- 
RAM7 4F ( 1(CA*3*a-S> <> 



(5) 



mmw- 10-86O80 

8 



[0 03 5] 9M*~v hrtCCBCPU*6tt«»K 

»«B8otiaas©*p<, fes^n, roms4M&w 

?S££teS«H0ft*)FttU RAM7 4&CjHtfrr 
& 0 *fc^2(DS*Sg«8 2«RAM7 4*»6*.(Da« 

Btt«l»«*IWlUrD/AaaftS8 8it-#7>^ 

ffllT^o 10 

f (0 sup, 0 swq) = l/sin(0 sup) + l/sin(0 swg) • • 
[0 0 3 9 ] »ffl*WfcHfltt?#*.ti, 5 tc, * <9 sup = H(Xb. 

6) sup B±i*CD{£B (SIR) (Xb, »)£30M(©fi¥ffi 
B (SlTffiS) (Xsup, Zsup) <DM?Brt*?K 6>swq « 
±f*<DfiiB (EKW) (xb, zb) £»<DJE^PGlB 

mm) (Xswq, Zswq) (DUBISrC *> S „ * 
H(Xb, Zb, X, Z)= 
acos [ { (Xb - X) • (Xb - X ) + (Zb 



[0 0 3 7 ] H^02JS*ffn^^ b Hcte^T. 
JW(7))(*TO(Dfttfft^esup , WolffiMgeofttfft* 

&h%:^i><Dt-?Z> 0 IP^, ffi0sup fccfc^Gswq BiE 
©ttiTS. £¥2 2R (L) <DfiHK* % AftWCCB, 

jstTMffiis, 2 or (D <Dttm (mm) it^ 

[0 0 3 8 ] C Ct\ 0 sup i 0 swq iCKT-5S#6^ft 
^M»fC0su Pl 0siug)CDW<k It, ^4tStSo 



SI 

Zb, Xsup, Zsup) 
6 swq = H(Xb, Zb, Xswq, Zswq) 
[0 040] C CX\ H(Xb, Zb, 



X, z) 



S2 a 
S2 b 



Z) • (Zb - Z)} /( 2 • L * L ) -1] 
• • • S3 

★ x, z) ©ar* sci cctt* o & « a 6 & > « 



(Zb- Z)^4 • L • L • 
[0 0-4 2 ] S2(C<t9, 



[0 04 1] tZ5X\ acos(D^a«^[-l,l]"CS>S^ 

r\ h cxb,zb.x,z) (Djzmmx. ^stjdfc-rcxb.zb, ★ 

(Xb - X ) • (Xb - X ) + (Zb - Z) • 

c©s«. J8M»±jb^b (sirwffi) ©ran*, w 

f CO sup, 0 swq)= fCH(Xb,Zb, Xsup, Zsup) , H(Xb,Zb , Xswq, Zswq)) 

[0 04 3] COCit*. WBOfttfftOBBftfcesup, 
flswgJB, ±f*€>{£B (KM) iPTJE^B (J£«fJ^ 30 
S) <DH8S£q(Xb,Zb, Xsup, Zsup, Xb,Zb, Xswq, Zswq ) &CB 

(Xb-Xsup) • (Xb-Xsup) +(Zb-Zsup) 
(Xb-Xswq) • (Xb-Xswg) + (Zb-Zswq) 

[0 04 5] St, C Cr^q(Xb,Zb,Xsup f Zsup,Xb l Z 
b,Xswq,Zswq)^^5l^, Xb, Xsup, Zsup, Xswq, Zswq£r 

[0046]ttll 40 
& S ±1*CD iS $ 5C*f It ( Xb , Zb , Xsup , Zsup , Xswq , Zswq) 

< 1*4 &C Otl r Mtfc q (Xb , Zb ,Xsup ,Zsup ,Xb , Zb , Xswq , Zsw 
q ) <D«ifft 0>Tft*©MttWWB* 

[0 04 7 ] COttltt, B@L WSg^tg0ffi 
iZ b©BB»***Tfc;B^-5#s, g<b0-(Dtf*f|o 

M*f ottH^e am^ apfe, h so 



S4 



S5 



[0 044] {IU q(Xb,Zb,Xsup,Zsup,Xb,Zb,Xswg,Zsw 
q)0^«ttv f(H(Xb,Zb,Xsup,Zsup) ,H(Xb,Zb, Xswq, Zsw 

^TZ> (Xb.Zb , Xsup ^sup.Xb^b, Xswq, Zswq) CDfit ^^> 0 
(Zb-Zsup) ^4 - L "L • « -S6a 
(Zb-Zswq) £4 • L • L • • • S6 b 
7{ttet>T±te<DW£Zb*ig< Utt^< WM<Dft 
ftfft 0 sup *$<fctf0 swq «»Cjffi^< CDV. S 1 CD^ffl 

sa©^e*s«5cia^* % fee su P , 0 swg)©fi«^^ cc 

[0 04 8] Cfttt, *»WCCB, 0 sup *fctt0swq 

^(DlR&mWzlCtJ: *) . f C 0 sup , (9 swq)OfBB^PK;*:{C 
[0 04 9] q(Xb f Zb,Xsup f Zsup,Xb,Zb,Xswq,Zswq ) & 

[0 05 0] ttH2 



(6) 



5£8 b 



C > CO • • • 

f(0sup,0swg ) =C • ■ - S8a 
g(Xb,Zb,Xsup,Zsup,Xb,Zb,Xswg,Zswg) = C • 
[0 0 5 1 ] ttS2©>£ffl 

mmomficis^xit. ±f** £ z b zmmicm.'msrft 
it. f&.Mffi&ng.¥- (JEirraffi) srogggtii. pes 
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*i*3Zb£3fi^ct$^TrrUi. S2a, S2b, S3r 
5l?#><E>ftS 6> sup t 9 swg ^K^^S-TS 
ftf So 

[0 0 5 2] 6 sup > dffi^e swg > S • • • 5^9 

±**iS3 z b &mmcm£-?tn*. s 1 o asstesn 

So 



gCXb,Zb,Xsup,Zsup,Xb,Zb,Xswg,Zswg)< 1/sin (5) + l/sin(6") • 

jk^-^> «J8toesn» isi*icROM8 4rtict&s*i$n 
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[0 05 3 ] C©£S©±ffi*3#»6lft*K_httil.3S 

S„ chit ^SC*«fi-r*tt*©CK*fur. S8b 

£«$£-rs_b<*«;s z b3*i?¥aE-i-*c 

1/sinC 6*) + 1/sinC 5) <C • • • SC 1 1 

VsinC 5) +l/sin(5) *C0i*j^t*. tt!T2#W& 

ns 0 

[0 0 5 4] Sfc. tt«l *6^©tt«*3»*>n4. 
[0 0 5 5] ttH3 
S8aS fct*S;8 b S±f*ift$ Z b i*C 

GS<ftS) 0 C 4, ±ft* 

§Zb(*m2©Se*g?^ffiO±#*J3KJRm-r-5. * 

[0 0 5 6 ] tt«4 

RHK f l ©W© <fc 5 (cfe6©IB8ffift«:*ror*H&t 

4, *©K«)aab, s^»j©w*5f#5STSo sp*^ w 
mwj>t£<xfttt. «£^r, ^fB#©imfi6ftiSS^>itffl 

fe/jNS< &s„ 

[0057] ±k*]»1I4 ur . c©38i©ftffc*iJMB 
irs, 

[0 05 8 ] 04«C^T£n< . C©§»tt, fi¥«Utt* 

t'©*tf©Wtt»*^i*6n, *tiKa-3c>ra©acf 
* (fiT«U») #&&£ftr£¥«ii^^-#4LT 

OTiei/fclM©-^? r 2 6©ROM8 4tCfft|fiSnS. 
[0 05 9 ] £fc. I*l/^t77^>iC*3^tSS 

f ( & sup , 0 swg) = 1/si n ( 6 sup) + 1/si n ( 6 swg) 



10 So (S8v ZMP (Zero Moment Point ) B, $§(CJ:-) 

■c»*-r s t mt><D&t)<D<mm*mm t &t> s 
ja-c&o, «t±^ia^i©^%*®±©*sfm** 

*J 9 ©# 4 - y > r V&M L It 4 * M Z * Rfi < - y 
[0 06 0 ] ♦8#,Sti-CC>S^7^-*B3K*R*ffiS 

18, 2 0 R (L) ©{£g • $») teJ:CF±fl. 

&m ■ Aw&a&*m s t» s. 

[0 06 1] JcO^teWteK. 057CJ--^i--hK: 
ijVr*n< , S 1 0 35>6M>&Lfca. S 1 2 KjtA/CSd* 

NfWAt (ftijfjiMWo witfiois) ct<Dm-?m 

»J U « 9 4 S 1 4K^T^s( 

t*AtK»BBl. s l 6 ec»A/cHSfl t <gt£B# 

m ictevz,mm±.mm®.s: (xb.Yb), @«±f*s5» 

(0xb, 0 V b, 0zb) . WJW©BSS¥ (SHWffi) iiL 
S (Xsup.Ysup.Zsup.Xswg.Yswg.Zswg)^^^^^ (0xs 
up, 0ysup, d zsup , 0xswg, <?yswg, 6 zsvkO^WHj 

TSo cne.©ffl«^Bffflr*s„ 
[0 06 2 ] s i 8 {CJi^-eas±ftW^ zbt 
#m-rs. ^s-rn«. c©sia{c*sist:«±fti«34 

[0 06 3 ] 06«-e©ss±^i«$^T;v=fyxA 

[ o o 6 4 ] H6 fc^-rr^^y xabhuM©** 

MS%3^7c{cK35L-fcfe©r*S. !ui£©*#Mit 
tit. yofr&jlA/e^&o 



30 



40 



Stl 2 



[0 06 5 ] sfc. ±fl«s*isto&r*yti&©iSf5Si u 
tjwt©s: (5fc©2^7c~c©i»w©s;8atcta^) «s 

j^. «CttCCtBS«iLfc. 
f(0sup,0swg ) =c • • -Si 3 
[0 06 6 ] C©H]fe©^-Cii, ^131:1 

fc. (S8. _h^]SS?rii:Sfi ; JiC»< Ci^r-€f^t^©-C^- 



50 



[0 06 7 ] WT, i6©7a"ft"h*ISitS 
£. jfcTS 1 0 0CC*j^rB«±tfi»3Z b 
So end, BaLhftWSZb*jRjR8l»K:J:r>-r*J& 
S/ci*©l7]»!ffl-C*So 

[0 06 8] il^tS 1 0 2*igf S 1 0 4{Cit*. W 

iELfc@«±»*Ti4g (xb, Yb) . mmn±.&is2z 

b, S«±f4c^$ (6>xb, 6»vb, <9zb) . WWCC-O^T 
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©@«u£¥ (jsmnafflo am- mm (xsu P , ysu P . z su 

p, 0 xsup, 0 ysup, 0 zsup , Xswg, Yswq, Zswq, 0xsw 
q, 6>yswq, 0 zswq) :fc6, W^BflttCj: ot^Rl 

«) 3£ic^jff©g«RflBHSttB (ffittf) £ 

g*IJE¥&g (£*Hflf&«l) ©^ ( TAXsup, Aysu 

P , azsupj to 5) tmm<DmmxmwffiM (mm) 
taaumai (.sMwmmm) <m. ( rAxswg, ays 

wq, Azswqj i05) £3j<#>S„ 
[0 0 6 9] S 1 0 6 (Ci»A, ZftMiOSItC 10 

®mBft0sm Mors l ostcji*. mx. 

1 3 ©ffii2©<S©MErr £3jcJt>-5 0 =W*B\J(C«. H^O 

SCI 2©*a36»63e»C*S»0-C^Err 

[0 0 7 0] MOT S 1 1 0 {tit*, Err ©Si&fctfji^llx 

+^/hsi»*s*>*«w-r4. s 1 1 o-csgfieirt. 

SP*S. +^/hSoi«»rStiSi*«S 1 1 2«cjB#, 
^•©£§©±{*1S3 Zb5:B8±M3K^l/Tyn 20 

[0 0 7 1] ffe^T. S 1 1 0t§S3h5itf»S 1 1 

C©5£«^Err ©S4Zb r«Sfc#l,rf#fc&©r* 

5„ Morsi i6{cji*. -e-©tt©ati±f$i«S(c 

- S - Err *fln*.fcfii. BPfe, MErr {CJ^jgS £?£D/t 

ZbKfUU s 1 o 4icmz>. 

[0 0 7 2]^, HKOM«tt«>9ltCHmt'CaS«± 
f*i«3CC-S • Err «AiiC.^fl9VmKOJ@HflKSit.& 30 

£©#sa* CO. 
[007 3]157a--?t- KcRSi. Mors 

2 o (ejiA,rat§±ft7}c¥{&g (xb.Yb > , gfiLH** 

Szb, Stt(±tt$f9 (Sxb, 0yb, 6>zb) . Fff)W©g«l 
M¥ (StrtSgii) feg-^ (Xsup, Ysup, Zsup, & xs 
up, (Jysup, 0 zsup , Xswq.Yswq, Zswq, 0xswq, 0 ysw 
q, 0zswq) :^6&ftl©iM**^f--f i'XvUStiCcfcor 
SS^Mgttfl, BP*. HfflOR(L). 12R (L) 

2«OH»©a«ftflE**a&5. *«>?tHflfftt3: 40 
BUfB LfcRAM 7 4 tCtS^T^., 
[0074] #Or S 2 2 fCjt*. **/cg«W«Bft i 
frSJ^CC, H5fBUfcS#^g2(CfcOTP^'y h©^ 

[0 07 5] C©Hlfe©^M«±fa©$P< HJ&Lfc© 50 
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[0076] BK. HUiBLfccfc S «C#fTf»tC >J r^5» -Y 
[0 077] KK. 3fc^llWt^K»LT»K5S£a 

•.twci*^, —#©»5M«jtfc±if *&■*©« 

aWBflU ft3Ef©W4<*»S-tt*Ct*st?*, W5te«© 
[0078] HK V ±flHDlBtt^rnffiBAi^:« < &SiC 

onraBf*M*©tttt*MJc*{t (WU) u iria±ft 
©*&e#ifijtfiai*yfc*:«:fc o t zmm.* 4ft*ct* 

**t?*wn (ft*) oat<rfe. -KMc**i,>«*r* 
fln (tfA) -r€>fe©r*ti(i^o. 

[0079]I38«C (O&msM 2 ©HSIS©?$»K:ffi3 
SBK©»fiS*^-r««B^o v ^ItS, 0 . H 9 «■€•©» 

[0 08 0 ] »2©HSfe©^r-« > H8 «C7n-r^!P< , 

m i ©*Jfe©^©±f**$i*«T^=fy XAK^i e. 
nss¥«i»©-gp(c. fSM©s^«is»*-^A-5=t^(c 

st) ©a^fiawfigf^^ no*? h*^*itSE-r-< 

[0 08 1 ] 09WH2©*)Sfe©J^jl5C^Sil»©«(j 
A«m l ©HSfe©^!S©H 5 

[0082] feiTtiwr* t . s 2 o o ids^ximm 
ws¥ (smraas) eims. ens, as&c^-r 

J:^(c^*^3lifc{KK (iiW) JETttS^^^-f 
{cs-5c»rgLm§*iSo Mors 2 o 2(ciiAra©± 

ftK3Zb*iS^J6L, S2044ItS2 06K^ 

r^ l ©JgJfe©BastlaISI«:ffi«±©&s©ll**a> 

[0 08 3 ] S 2 0 8*002 1 8^1tSl © 

ss«©^«©ia 6?n--3^-ht mmtxmmzn 

©*NK>J&*©*BItt. ^l©HJfe©^©-entM* 
6*o„ 

[0 084] 02©HJ6©^SgK±fB©in< ffi!%l,?c<D 
r. ^lOHSfeC^MtlSI^Kc, ±M2»<^7y 
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< ft £ J: 5 ic±f*i« $ £itiBc&;rr & c <b #i-c £ £ <k 

j&^scBftft#fT£ll^r3c <ta^e#£. 
[0085]^ mi comm<Dmmt,cm^<?> m-sic 

m (±m%5%<Dm) ##£-r ^m&tm^i&< fts 
a*. mm&¥<D<$mim*m<ttztMcj:-o-c. hi 
ncfjk-rx^ic. ±fc<DM2zm,m{Mc$£{tzM?>ct io 

[0 08 6] iftcDiTatt^^^S^ti-fc^ 
«^ic», «W£¥©^&ftg£S«{igJ:Dfe^>>I 

<DTttam&&±% < TJ£¥2 2 R ( L) ©ffiilfiK*^ 

< ft £ Bf M£ » x tr >^ - jt > h #s A£ < ft & B$?aia> 

[0 08 7] 012 «C©f6HJ©IS3 a9£tt<Z>7£jHttCffi 20 

h i 3 um^ ©sus©?gi»{c«4fgHt?f#e>n*±flc«i 
Sf©i«Bj0r^s„ 

[0 08 8] m3<D9m<DM&lxm2<D9m<DJ&&<D%E 

ifcfrfa&c-o^-c©, *m& Mfjaw^<t©^f©^tta 

[0 08 9 ] HI 3t**ftfcJ:o'tfc5e3ft*±#i*3 

ffltr*»). «Wi*J(EffllkHw:J:S«*^'r. H^©*n 

< . iKMfiTOfiHrottirefflffi 3 *Ttf S C t J: ») . 

[0 09 0] fiP^ H^©2JS.^tfP^*^ h 1 ©^tfilJ 

®M*\&<?Z>t. Jftmffl6R (L) *ftW-C#tfT 

^f. K<frttj|t#(igji?&<>:, S'i>©±T«i#i*£ <ft-? 40 
rSSffiJS*©±TE£^ (_hT»naig) O&UffiMBtfttt 

[0091] m3<Dmm<Djmj,t±m<DHa<mm l ^ftc 

[0092] hi 4{*^<Dwn<omA<Dmfc<Di&mc% 

[0093] m4<Dmm<Dmmi>, m3<Dmm<ommt 
mmic. m2<Dmm<omm<ommx-$ } K). h^©sb so 
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- £ to J: iMEHja¥*W^« 9j* - * 2 *>6 ft S 3 «©;■? 

9 ^ - * 5i*ic, Gaafi¥4M*iwiy * =*• y 

[0 094] <g^¥«*JWHT;l'=f U 2 "CUffi 3 

fis • ». is 1 <z^e»<D0«t?as^fc**w&« 
twit?**, ffitff. «sua 3 F*wwwHr^=fyxAi'c 

m&tcmm-rz b<D-c*> <o . «EBia¥iU»»ffiT^=f y 
[0095] m«(c, ±fwss8Her;v=f y & 3 m 

*Jt©^^ra-</t«WftfflZb2 (C*rU -httASST 
;l/3f V 3 ri*^3 ti-SffiZbl, 3 IS. ±ftlft3 © 

[0 09 6] ^?hfc3fflOfi(3aut^7'C 

6 tlfc±i*iS 3 to J: W-e©^©^' 5 - ^ fcSrJO s 

[0 09 7] »4©*Sfe©^«±ie©*P< «fiSUfc© 
^(DiLQ < , 3 ffl©iiS^©¥^ltizbav?:#& 5Ci "CM^ 

% t # a £ -^©®#©a* c >mfzft >>mcb. ± 

[0 0 9 8] CCT, IS2 ftl* ©X*fe©0?jT*ffl 
ti/'cMIjaWS¥«LS* ; Sr^'r-S.^ : f*Wft^ft^«T^ 

b ) WS^©«lS*?r. *UilSA^5fefca*0fc7^;l' 

f (#pg^5 - 3 2 4 1 1 smmoy&M) 

c ) »a^©stffi»{c, 3f^©T<=.uM©^raims!t 

[0 099] ^2ftt,^^4©Slli©m^Ctot,i 

©^n^JWT(c^-r 0 

^ . gram t i «j «> h z tmftom m±.fc&m*m& 

[0100] 



15 

mi: 

m 

Xbv(t)=2WnXb(t+kAt) 
k=n 

Xbv(t) liNfMt<0«.«±t*:*¥fe«o 
[ 0 1 0 1 ] b ) ^£©S©±&7k¥tiig£:7 ^ )V$IC 

(TnS + 1)/ (TdS +1 ) 

[0102101 55*C©^©^5©J||ft©ff^Cil 
[0103] »5©*]5S©^r«. HI 1 5 5C^-r£n 
[0104] *5©|Qfc©J&««Cffi.6±tti*3& 

its. ft. mmg.f&tcm-tzs -{>T)itt vxMtm 

1 ©stefe©Jf2*I©0 5 £ |5l«-C* S. 

[0 1 0 5 ] MTMW-f&t, S3 0 0(Cfel,>ni© 

*ife©jf^ra!-<>t±f*^ ssae;!/- * > < 0 6 ■? o - 

• h> £SSff 0, ±M2Zbt*&S„ ft. ± 

(Dlfflmttitc-yXm-ft, 5fctc01 1 ic^L/tJ^fr 
(CCT rjBQB&j iLT^^SCiA^-c 

[ o l o 6 ] Mi vr s 3 0 2 icMA,x>£>sbtc±.fcm$ ic 

^II«±©H88Rlifc#*a»r T S C £ *5-c |e . SHU: 
[0107] *5©3(E*©3KIH*JJB©SP< flfl&l/fcC 

So 

^nvy&t #(c«, m^itici. -?x±.wm 3*jfcj&»fc#> 

[0 109] 017 «C©^BJ©IS6©|«©ff5!^tCtfc 
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S»«©l»S*SVr«l6:/n *Ht?* *0 , S18Bf 

[oiio] jS6©fEJfc©^»{c*-9r{*. an ©396 

©»«*flSl»r»fca«Lhfl£J»3 <»lJW«#£m5> 
£ % ±M3*-S(Cgoil) 5 Iff 1 ©SfefE^^-C 

■o x sm±wm 3 s £ 5 k o fc 0 

[0 1 1 1 ] 0 1 8?P- • ft-h^#MLtl6© 

10 36»©»«Kc«s(K*©±fl5*si»!5er/i'=fyXA%si 
wrs. ft. *8ffis«cpi-r*y-f>r*=fyxAttj|i 
i (Dmmmmvms tmmx&z. 

[0112] 5fe-T S 400 tC*s\.>XW 1 ©3U!i©^JSt? 

as icwisxm^tctm&n *oxm&Bm}x-<Dm&±.# 

iSS (SlMf) £f#£o ttt,>TS4 0 2K»A/C4te 
K# 1 ©fie3t^B#ffit LTxE^/cH^J©^!^^ 

xmtffimx<Dmn±#mz m2<omm) *^&> 

So 

[01 1 3 ] mi>X S 4 0 4 tCjtA,-CJfifiEB^ (Nf^J 
20 t) T©1*W1, W2^T5. ffib. t*Wl, 
W2», Wl +W2 = 1 £jjSJSU Wl, W2-€-tl-etl 
©BSfflltf bW»6*»'C*S «fc 5 K&STS. SfcOT S 4 

o 6icjt^flD*¥^ffl*#tB-rSo an^, jbk f2 
[0 1 14] SS6©HJfe©^SI(c*-3-r»±aa©ftp<i# 

gc-rsci-c. uwmmmmmxoyn^cmzx. m 

«J:ffiB3tC-3t»r. ^lMiS?f${C*fLrfiJ^«^2© 

30 «-rsctms. fiu h o oasf-st. 

So 

[0 1 15]». f 6 it »M W 2 o© 

[0 1 16] *6C«EW©Jg»r». S21» 

t£*Kji#Sv lKf^.«, *1 ©5E*©0ffl»:»r» 
UW 5 ©**fi©J$&JC7n L fc^S«^©^ft?:ffl I 

jiai©i»m*>*ffli»r»T4»jsit». 
[0117] mi<Dmm<D%m. m2<omm<D 
itm> h^umzu^vmbo^mm^m^x'p 

^&idmn<o±.w& 3 mmzzzii&Lx^nibCDijmB 

[0 118] Etc. «T©#£K«fc-3r«jftj&*»t«> 

50 S) 
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e)t77-/ 1 <03Ufc©»«*ffll>r 1 *#©M 

igff$5:f#, Ctl&HI 1 f--7';KC«ff U &(Cj& 1 

[0 119] #5 ©51*©** fSettUg 
*»») 3 4 *«c«Sffl«fiDS«J:<W3 <0 fciS 

[0 1 20] il 9 WC©#6BJ©^7 ©3U6©J£!!S{ttfi 20 
[0121] » 7 ©**©#««:* oTtt. *6©3«6 

[oi22]H2o-7p- - * + - b%mmvxm7<D 

058. ^^{CPsBT-S^-Or^a'UXA^l© 
*W©^»©H5iR|»t7*4. 30 

[0123] tTFiaijrrs t. s 5 0 o&oos 5 0 6 
cosier $ 6 (Dmu<Dmm tmmcDi&mzn -c a«± 
3 *f#fcft. s 5 0 8 tcat^/mfc* 5 ©uss 
<mmtm®(07 -< t\s$mm*'<f*>. 

[0124] ^7©nj6©^!s«±ia©*n< mmi>tc<D 

(Dmmmmicttm u -c-jwt 6#>&±#*.»*sa c 

[ 0 1 2 5 ] 02 1 BC©»!S©Sff8©**©»j»tc« 
**«©#jffi*^**^'n * ^Ht?*S„ 40 
[0126] ^8©^Sfe©jf^c&or«, HS*©*n 
< . ffi 7 ommmmom m.^m^ # s ,t s k l/c 

BP%. »lM^iH2M?S»K«r^tl-enftnS^L.r 
&?"JW«:£t&U ^-ti?raa-W5, W6*ffl(,»-3oJnM 

¥^jura«±{*« «fc 5 jci,fc. cc-c. m 

*W1, W3, W5, *5WJW2, W4, W6«, 

tuetisttsttrtiai— site 
[0127] Sr8©HJ6©^Ji«:*si>'Ctt±ia©*n< til so 
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jsu/cct-c. mmtu-c i*ffi«r©3tE»©»iBcjt« 0 
[0128]©. cftja±K¥»ffc^<r» 
»br*>. wipoii, snastt, mtcmmirzffiftft 

[0 1 2 9 1 122 ttC©#£BJ©m9©IUfi©^!SSCC^ 
S*Sira*JS*^BW!ISr*.&. S£9©**S©J$&CC 

*jt»r»4ja (fi) ^tf©ptf hmiL, ^©0 
[0130] felTWWTSi, H^©4JE^fajJC-? H 

ioob, ±» mm io24, ztiictmmmm 1 

04 (IWBUfcJill©BB») ?r/CU-rilffi§nS4*© 

iWJy>* 1 0 6*»e>fc*. 4*©w§P'j>^ 1 0 6« 
-e©*^ 1 0 8 &©mtcttmffi 1 

10 (m&l>tcM2<DmB) *ffi%.Z> a HwBiai* 
[0131] H^©4S^tfa4<y b 1 0 0CC*$t,vCfe 

mm(Dmw<DBm~e<D 2 s*&?f n # * 1- 1 4 piste . ± 

ffcl 0 2©?K¥teM (Xb, Yb) *>«fcO*^9 (0xb, By 
b, 0 zb) ?0a»T?±#©i*3 Z b 

10 4, 11 OSrfKS&flJfflU ioTHiC^Ep-C^-r^ 
|flKC»fT3-tt5e£#t-C*S. 
[0132] ±IBt:\ H2 3 (C^"TAn< ±#ft$ Z b 
tt» ±ftl0 2 ©SH©tp'^ 1 0 2 a 112 4© 

* 1 0 6 ©J$H8iB 1 1 0 ©ftK?: 6» n . 1 0 8 © 

(Xn, Yn, Zn) (n : 1~4) X'mT, 
[0133] ^9©HJi©0^CC#5SM©Kif , P^02 

47D- • g=-+- h^#Mbr^Bj-rs4, seoo* 

6S60 4 *r^©3$fc©JE?*iHtt©*ra*ffofc 
S 6 0 6 Kj^-C^ t KfcWS S*±#*JMft« 

(Xb, Yb) . BftLhtt%& (6»xb, 0yb, 6 zb) . fcj: 
- CfSABPj^tMta (Xn, Yn, Zn ) (n : 1-4) 
»v S6 0 8(<:MtgS±ftiS3Z b^*»S„ 

[0134] M2 5W-?-©flP*4^-r-!f^;l'-?> • 7 
P- • 3^-h-C£>«3, «T^-r§4. S70 0, S 
7 0 2 *BT S 7 0 4 tcjlfc*. SM±f**¥f4g (Xb,Y 
b). mmn±»H$2 Z b . _h«556»<0xb, 0 V b, 0z 
b) , fc^CflWftSBftH (Xn.Yn, Zn) *>6. «-W©S^ 
#W«M85 1 0 4 ©MS (mm) 4 1 0 8 © 

(4B©fi (AXn, AYn, AZn) B2 3CCCn 

6©M^^-To 

[0135] ^>TS 7 0 6CCji^*afrfc!i#>607j* 
©Si*ffl(#»rB?n»ften**»S. *^S7 08K 
MErr *H^©*n< SHil, S 7 1 0 (Cjt^^ 

«S 7 1 2«Cjttf4±fcK. §S3tl5itttS7 1 4CC 



(11) 
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i!A/C'JS8&S£#«> > S 7 1 6 ICte^xmz b*WiE? 

[0136] »9©3g*CD»»tt_he©*n<«tSOfcC 

4JS. (4JW) ^ffnsK-^ Kc*$C»rfe, 2£ 
(2 BP) #frPjK» h£ITOc*acc±{*iS3£*i&.S 

[0137] _bf BcdSp < . < ± €>_hf*2 4i. MIB 10 
±&lcm 1 ©W0 1 0 , 12, 14R (L) ^LTi 

> ^ 3W*©3Ha»* "C tcd>fe < £ & 1 <!©31 2 ©M«5 1 
6R (L) *WLrasWS»tta>K» h©£®£SSSI 

mc *st, » r , grsLh#©*¥#fii saitis** j: £>'*#© 

«48fc<. ±«:«l®S:4sSS£-r-5±»«llgJ^^e (S 1 

6) . mmm^ , )y9$ffi£^&wmti5£zmm<o'p 
y>**BW93e*a (s 1 6) . *j<fcw«riBtB£3*ift: 20 

3ers±fMsa*itia«fl[«ftje*s (sis, s 1 0 

0^LS116, S 2 0 Ofil^lS 2 1 8 , S300 
&UI/S302, S 4 0 0&(,>LS4 0 6, S 5 0 0 & 
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